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Abstract 

Terrestrial  manipulators  with  more  dof  than  the  dimension  of  the  workspace 
and  space  manipulators  with  as  many  manipulator  dof  as  the  dimension  of 
the  workspace  are  both  redundant  systems.  An  interesting  problem  of  such 
redundant  systems  has  been  the  repeatability  problem  due  to  the  presence  of 
nonholonomic  constraints.  We  show  in  this  paper,  contrary  to  the  existing 
belief,  that  integrability  of  the  nonholonomic  constraints  is  not  a  necessary 
condition  for  the  repeatability  of  the  configuration  variables.  There  exist 
certain  trajectories  in  the  independent  configuration  variable  space  that  are 
like  "holonomic  loops''  along  which  the  redundant  manipulators  exhibit 
repeatable  motion.  In  this  paper  we  present  a  simple  method  based  on 
optimization  techniques  for  designing  repeatable  trajectories  for  free-flying 
space  manipulators  and  terrestrial  redundant  manipulators  under 
pseudoinverse  control. 
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1.  Introduction 


An  important  problem  of  kinematically  redundant  robot  manipulators  has  been  the 
repeatability  problem  under  pseudoinverse  control.  This  problem  was  initially  observed  and 
analyzed  by  Klein  and  Huang  [7]  where  resolved  motion  rate  control  [22]  using  the  Jacobian 
pseudoinverse  was  noticed  to  result  in  nonrepeatable  joint  motion.  As  an  alternative  to  the 
pseudoinverse  control,  Baillieul  [2]  proposed  the  extended  Jacobian  technique  that  lifted 
closed  end-effector  paths  to  closed  joint  paths.  Later,  Seraji  [15]  proposed  the  configuration 
control  technique  that  also  resulted  in  repeatable  joint  motion.  The  key  idea  behind  the 
extended  Jacobian  technique  was  to  add  enough  independent  additional  constraints  to  the 
motion  of  the  manipulator  so  that  the  rectangular  Jacobian  of  the  redundant  manipulator 
could  be  converted  into  a  square  Jacobian  of  full  rank.  When  the  additional  constraints 
that  are  imposed  upon  the  motion  of  the  redundant  manipulator  are  holonomic  in  nature, 
the  full  rank  square  Jacobian  guarantees  repeatability  in  the  joint  motion. 

Though  the  pseudoinverse  control  does  not  produce  repeatable  joint  motion  in  general, 
it  is  fundamentally  similar  to  the  extended  Jacobian  technique  in  the  sense  that  it  is  also  a 
form  of  constrained  motion.  For  a  redundant  manipulator  with  n  degrees  of  freedom  and 
a  workspace  of  dimension  m,  the  dimension  of  the  null  space  of  the  manipulator  Jacobian 
is  equal  to  (n  -  m).  The  extended  Jacobian  technique  [2]  imposes  («  -  m)  additional 
independent  constraints  on  the  motion  of  the  system  to  make:  the  Jacobian  square  and  lull 
rank.  The  pseudoinverse  control  is  equivalent  to  the  imposition  of  (n  —  m)  constraints  that 
direct  the  motion  of  the  joints  orthogonal  to  the  (n  —  m)  dimensional  null  space.  While  the 
constraints  due  to  pseudoinverse  control  are  nonholonomic  or  nonintegrable,  the  constraints 
imposed  by  the  extended  Jacobian  technique  are  holonomic  or  integrable.  Therein  lies  the 
essential  difference  between  the  two  approaches,  more  of  which  will  be  discussed  in  section 
2. 

The  pseudoinverse  control  problem  has  been  studied  by  a  number  of  researchers  |7j, 
[8],  [9],  and  [16].  Klein  and  Huang  [7]  analyzed  the  nonrepeatability  problem  of  a  three 
link  planar  redundant  manipulator  in  terms  of  the  integrability  condition  of  a  Pi'aflian 
differential  form.  Shamir  and  Yomdin  [1G]  asserted  that  for  a  redundant  manipulator 
repeatability  is  guaranteed  if  and  only  if  there  exists  an  integral  surface  of  the  distribution 
spanned  by  the  column  vectors  of  the  Jacobian  pseudoinverse.  Under  the  differential 
geometric  framework  adopted,  it  was  concluded  that  the  repeatability  of  a  redundant 
manipulator  can  be  assured  if  and  only  if  a  certain  "Lie  Bracket  Condition"  (LBC)  is 
satisfied.  In  section  3  of  this  paper  we  will  show  that  this  LBC  is  not  a  necessary  condition 
for  the  repeatability  of  redundant  manipulators.  We  will  also  show  in  section  2  that 
the  LBC  is  not  a  sufficient  condition  for  repeatability  when  applied  to  arbitrary  extended 
Jacobians.  This  contradicts  some  of  the  discussion  by  Luo  and  Ahmad  [9]  who  discussed  the 
measure  of  repeatability  for  planar  redundant  manipulators  under  pseudoin verse  control. 
They  used  a  framework  based  on  the  theory  of  integration  on  manifolds.  The  authors  in 
[7],  [9],  and  [10]  have  all  concluded  in  essence  that  integrability  is  a  necessary  condition 


for  the  repeatability  in  redundant  manipulators.  Similar  opinion  was  also  expressed  in  [3j. 
We  do  not  quite  agree  with  this  statement.  Our  contention  is  that  integrability  is  only  a 
sufficient  condition  for  repeatability,  it  is  by  no  means  a  necessary  condition.  In  section  3 
will  derive  a  weaker  necessary  condition  for  the  repeatability  in  redundant  manipulators. 

In  1989  Klein  and  Kee  [8]  presented  a  numerical  procedure  to  find  stable  drift-free 
trajectories  in  redundant  manipulators  under  pseudoinverse  control.  Later,  Klein  [6]  tried 
to  predict  the  stable  drift-free  trajectories  of  [8]  by  using  the  Lie  Bracket  Condition  (LBC) 
in  [16].  The  results  indicated  that  the  stable  trajectories  in  [8]  are  not  contained  in  the  LBC 
surfaces  of  [16].  This  bears  testimony  to  the  fact  that  the  LBC  of  [16]  is  not  a  necessary 
condition  for  repeatability. 

Recently  Roberts  and  Maciejewski  [14]  presented  a  necessary  and  sufficient  condition 
for  the  existence  of  stable  surfaces  for  repeatable  motion  in  redundant  manipulators.  They 
showed  that  the  Lie  Bracket  Condition  (LBC)  of  [16]  is  a  necessary  condition  for  the 
existence  of  an  integral  surface,  but  it  is  not  a  sufficient  condition  for  the  surface  to  be 
stable  for  repeatability.  Since  stable  surfaces  are  quite  rare,  the  authors  [14]  designed  a 
repeatable  control  that  is  nearest,  in  an  integral  norm  sense,  to  a  desired  optimal  control. 
In  this  paper  we  are  concerned  with  repeatable  trajectories  but  not  with  their  stability. 
Though  the  LBC  is  a  necessary  condition  for  a  stable  surface,  we  show  that  it  is  not  a 
necessary  condition  for  repeatability.  Using  a  necessary  condition,  weaker  than  the  LBC, 
we  will  show  the  existence  of  'iiolonoinic  loops"  that  lift  closed  paths  in  the  workspace  to 
closed  paths  in  the  joint  space  under  pseudoinverse  control. 

With  no  intention  of  digressing,  we  would  like  to  mention  that  space  robots  with  as 
many  manipulator  degrees  of  freedom  as  the  dimension  of  the  workspace  exhibit  a  special 
kind  of  redundancy  called  "nonholonomic  redundancy".  It  was  shown  that  nonholonomic 
redundancy,  unlike  ordinary  redundancy,  manifests  itself  only  after  a  global  motion  and 
is  not  characterized  by  "self-motion"  manifolds  [12].  Inspite  of  fundamental  differences 
between  nonholonomic  redundancy  and  ordinary  kinematic  redundancy,  more  of  which 
will  be  discussed  in  section  2,  the  control  problem  in  both  is  characterized  by  the  non- 
integrability  of  the  distribution  spanned  by  the  vector  fields  of  the  system.  Hence  the 
repeatability  problem  in  space  manipulators  with  no  additional  degrees  of  freedom  and 
terrestrial  redundant  manipulators  are  inherently  similar. 

Since  space  manipulators  are  also  redundant  systems,  the  repeatability  problem  in 
space  manipulators  fall  within  the  scope  of  this  research.  While  the  problem  of  reorienting  a 
space  multibody  system  using  internal  motion  has  been  studied  by  a  number  of  researchers 
[10],  [11],  [13],  [18],  [21],  [23],  etc.,  an  important  problem  that  has  not  been  addressed  so 
far  is  the  repeatability  problem  in  space  manipulators.  The  motion  of  the  end-effector  of  a 
space  manipulator  is  related  to  the  joint  motions  through  the  "generalized  Jacobian"  [19] 
by  eliminating  the  dependence  of  the  end-effector  motion  on  the  change  of  orientation  of  the 
space  vehicle.  While  the  joints  of  the  space  robot  move  along  closed  paths,  the  orientation 
of  the  space  vehicle  does  not.  Consequently  the  end-effector  of  the  space;  manipulator  does 
not  move  along  a  closed  path.  And  conversely,  the  joints  of  the  space  robot  fail  to  move 
along  a  closed  path  when  the  end-eifector  traces  a  closed  path.   While  a  more  complete 


discussion  on  this  topic  will  follow  in  section  2.3,  we  only  like  to  reiterate  here  that  the 
manifestation  of  redundancy  in  terms  of  nonrepeatability  in  the  configuration  variables  is 
observed  in  nonholonomically  redundant  space  robots  and  ordinarily  redundant  terrestrial 
robots  alike. 

The  rest  of  the  paper  is  organized  as  follows.  In  section  2  we  take  a  look  at  the  control 
of  redundant  manipulators,  including  space  manipulators,  from  a  different  perspective.  In 
section  3  we  derive  a  necessary  condition  for  repeatability  in  nonholonomic  systems  like 
space  manipulators  and  redundant  manipulators  under  pseudoinverse  control.  We  use  this 
necessary  condition  to  find  repeatable  trajectories  for  nonholonomically  redundant  space 
manipulators  in  section  4  and  ordinarily  redundant  terrestrial  manipulators  in  section  5. 
In  section  6  we  present  some  results  obtained  through  computer  simulation. 

2.  A  Different  Perspective  on  Redundant  Manipulator  Control 

2.1  Pseudoinverse  Control  as  a  form  of  Constrained  Motion 

Kinematically  redundant  manipulators  have  more  degrees  of  freedom  than  the  dimen- 
sion of  the  workspace.  For  such  systems,  the  direct  kinematic  relationship  can  be  written 
in  the  form 

x  =  f(0)  (1) 

where  x  e  R"'  represents  the  workspace  variables,  0  e  Rn  represents  the  manipulator's 
joint  variables,  and  n  >  m  by  the  definition  of  redundancy.  Differentiating  Eq.(l),  we  get 

x  =  JO,        J=(%)*Rmxn  (2) 

where  J  is  the  manipulator  Jacobian  matrix.  The  pseudoinverse  solution  invokes  the 
control  law 

0  =  J*X  (3) 

where  J*  e  Ruxm  is  the  pseudoinverse  of  J.  We  will  always  assume  in  our  discussion 
that  the  manipulator  is  not  at  any  singular  configuration.  Therefore  the  Jacobian  will 
always  have  full  rank  and  the  null  space  of  the  Jacobian  will  have  a  dimension  of  (n  -  m). 
The  pseudoinverse  solution  has  the  minimum  norm  property  which  implies  that  the  joint 
motion  6  obtained  from  Eq.(3)  will  have  to  be  orthogonal  to  the  null  space  of  J.  The 
orthogonality  requirement  is  a  constraint  on  the  joint  velocities  6.  Since  the  null  space 
of  J  has  a  dimension  of  (n  -  m),  the  pseudoinverse  solution  in  Eq.(3)  will  impose  (n  -  m) 
velocity  constraints.  To  illustrate  this  concept  we  consider  the  simple  three  link  planar 
redundant  manipulator  shown  in  Fig.l.  The  lengths  of  all  the  links  of  the  manipulator  are 
assumed  to  be  unity  for  simplicity.  The  workspace  is  defined  by  the  Cartesian  coordinates 
X  and  Y  and  the  manipulator  configuration  is  described  by  the  absolute  angles  uu  Oj,  and 
fl3.  The  direct  kinematic  relationship,  as  in  Eq.(l),  is  of  the  form 


A'  =  COS  Oi  -f  COS  0-i  +  COS  #3 

(4) 
Y  —  sin  Oi  +  sin  02  +  sin  03 

Therefore  the  Jacobian  matrix,  as  in  Eq.(2),  is  given  by 

j        /-sin  0i      -sin  02      -sin03\ 

6         \      COS  0!  COS  02  COS  03  y  *    ' 

The  Jacobian  lias  a  1-dimensional  null  space  whose  basis  vector  can  be  conviniently  ob- 
tained as  a  cross  product  of  the  row  vectors  of  Je.  The  velocity  constraint  due  to  the 
pseudoinverse  control  can  then  be  expressed  as 

sin  (03  -  02)  dOi  +  sin  (0j  -  03)  d02  +  sin  (02  -  0X)  d93  =  0  (G) 

A  necessary  and  sufficient  condition  for  the  integrability  of  a  differential  expression  of 
the  form 


is  that  [5] 


v\  da  -\- v2  d/3  -\-  v±  d-y  =  0  (7) 


dv2      dvA  fdv3      dvi\  (dvx       dv2  , 

57 -WJ  "V2 \o^ --^)+V3{-dp-^] 


Using  the  necessary  and  sufficient  condition  above,  it  is  quite  straightforward  to  show 
that  the  constraint  due  to  pseudoinverse  control,  given  by  Eq.(G),  is  not  integrable  or 
rionholonomic  in  the  general  case.  Therefore  the  three  link  manipulator  shown  in  Fig.l 
has  three  expressions  of  motion  under  pseudoinverse  control:  the  two  kinematic  relations 
given  by  Eq.(4),  and  one  nonintegrable  constraint  given  by  Eq.(G). 

In  the  general  case  of  a  redundant  manipulator  with  u  joints  in  an  m-dimensional 
workspace,  there  are  (/t  -  m)  nonholonomic  constraints  (the  number  of  rionholonomic  con- 
straints is  equal  to  the  degree  of  redundancy  in  the  system)  imposed  by  pseudoinverse 
control  and  m  kinematic  relations  for  a  total  of  n  expressions  of  motion.  Of  course,  the 
nonholonomic  nature  of  the  pseudoinverse  constraints  need  to  be  ascertained  from  the 
more  general  test  for  integrability  in  n  dimensions,  provided  in  Appendix- A. 

When  the  manipulator  has  as  many  degrees  of  freedom  as  the  dimension  of  the 
workspace,  i.e.  m  =  n,  the  Jacobian  is  square  and  has  no  null  space  assuming  of  course 
that  the  system  is  not  at  any  singular  configuration.  Then  the  pseudoinverse  control  does 
not  impose  any  nonholonomic  constraints;  the  motion  of  the  system  is  entirely  governed 
by  the  n  direct  kinematic  relations  that  are  holonomic. 

2.2  Repeatability  using  the  Extended  Jacobian 

Consider  a  simple  nonholonomic  system  whose  constraint  equation  is  of  the  form 

dz  =  adx  +  bdy  (9) 
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where  x,  y,  and  z  are  the  system  variables,  arid  a  and  b  are  functions  of  x  and  y.  The 
variables  x  and  y  can  be  considered  to  be  the  independent  variables  of  the  system  and  z 
may  be  considered  to  be  the  dependent  variable.  If  x  and  y  move  along  a  closed  path,  the 
change  in  the  dependent  variable  z  is  expressed  as 


/*■  Ladx +bdy= JL  (i "  I)  ** 


In  the  above  equation  the  line  integral  was  conviniently  expressed  as  a  surface  integral 
using  the  generalized  Stokes'  Theorem  [1]  on  the  2-dimensional  oriented  manifold  D.  OD 
is  the  path  of  line  integration  and  is  the  boundary  of  the  domain  D.  Since  the  constraint 
in  Eq.(9)  is  a  nonholonomic  constraint,  we  can  show 

db      da 
dx      dy 

by  using  the  test  for  integrability  in  Eqs.(7)  and  (8).  Then  it  simply  follows  that  the 
dependent  variable  z  does  not  move  along  a  closed  path  as  the  independent  variables  x 
and  y  move  along  closed  paths.  Clearly,  all  the  variables  of  the  nonholonomic  system 
in  Eq.(9)  do  not  move  along  closed  paths  simultaneously.  This  is  true  for  nonholonomic 
systems  in  general  including  redundant  manipulators  under  pseudoinverse  control.  The 
pseudoinverse  control  of  redundant  manipulators  result  in  nonrepeatable  motion  of  the 
joint  variables.  Conversely,  holonomic  systems  are  characterized  by  repeatability  in  the 
configuration  variables  that  can  be  proven  directly  from  the  test  for  integrability. 

The  problem  of  nonrepeatability  of  nonholonomically  constrained  redundant  manipu- 
lators under  pseudoinverse  control  can  be  remedied  by  using  the  extended  Jacobian  method 
[2].  For  a  n  joint  redundant  manipulator  with  an  m-dimensional  workspace,  the  extended 
Jacobian  method  imposes  (a  -  m)  independent  holonomic  constraints  of  the  form 

g(0)  =  (),         gel&l-,n)  (]()) 

These  holonomic  constraints  are  similar  to  the  direct  kinematic  relations  in  Eq.(l)  and 
can  be  used  to  augment  the  manipulator  Jacobian  in  Eq.(2)  for  constructing  the  extended 
Jacobian  as  follows 

j)  -  JeO,        Je  £  (/J  e  ir-,        Jo  ±  (H)  e  fi<— >*•  (u) 

The  above  equation  indicates  that  we  have  artificially  increased  the  dimension  of  the 
workspace  from  m  to  ?i  and  in  effect  we  now  have  a  nonredundant  manipulator  with  a 
square  Jacobian.  Rom  our  discussion  in  section  2.1,  we  know  that  the  pseudoinverse 
control  of  such  a  manipulator  does  not  impose  any  nonholonomic  constraints.  The  mo- 
tion of  the  system  is  then  governed  completely  by  the  m  direct  kinematic  relations  in 
Eq.(l)  and  the  {n  -  m)  additional  constraints  of  Eq.(lO).  Holonomic  systems  are  char- 
acterized by  repeatability  and  the  extended  Jacobian  technique  achieves  repeatability  by 
converting  the  "redimdant-manipulator-pseudoinverse-control"  nonholonomic  system  into 
a  holonomic  system. 


An  alternative  way  to  look  at  the  extended  Jacobian  technique  is  to  reconsider  the 
constraints  in  Eq.(ll).  If  we  group  the  joint  variables  0  €  Rn  into  two  sets  consisting  of 
0!  e  Rm  and  02  e  R'1'"1,  we  can  write  from  Eq.(ll) 


*-**+**.        j, *  (If).  *&  (|{)  (12) 

0-JO1*,  +  JoA  J01ft(^).Jc2ft(^)  (U, 

Since  the  (n  -  m)  constraints  in  Eq.(lO)  are  all  independent,  it  will  be  possible  to  find  the 
set  02  €  iP*~m  such  that  the  matrix  JGi  is  always  invertible.  Then  Eqs.(13)  and  (12)  can 
be  written  as 


e2  =  -jG2  '  jG1  ex  (M) 

X  =J0x,  J  =  (Jj  -  J  Jen"1  J  a)  €  ftmx,n  (15) 

The  above  equations  are  modified  differential  forms  of  Eqs.(l)  and  (10)  and  are  therefore 
holonomic  in  nature.  Since  the  Jacobian  J  is  square,  the  system  in  Eq.(15)  virtually 
represents  a  nonredundant  manipulator  with  x  as  the  workspace  and  Q\  as  the  joint  space. 
Therefore  the  pseudoinverse  control  of  Eq.(15) 

0X=J#X  (16) 

imposes  no  nonholonomic  constraints.  This  follows  from  our  discussion  in  section  2.1.  This 
along  with  the  fact  that  Eq.(15)  is  a  holonomic  equation  implies  that  the  constraints  of 
motion  of  the  system  in  Eq.(16)  are  holonomic.  Therefore  closed  paths  in  the  workspace 
x  will  result  in  closed  paths  in  the  joint  space  0U  provided  the  manipulator  does  not  pass 
through  any  singular  configuration.  This  follows  from  our  discussion  earlier  in  this  section. 
Additionally,  since  Eq.(14)  is  holonomic,  closed  paths  in  the  space  of  the  independent 
variables  Oi  will  result  in  closed  paths  in  the  space  of  Oi  -  the  dependent  variable.  In  effect 
the  extended  Jacobian  method  will  lift  closed  paths  in  the  workspace  x  to  closed  paths  in 
the  joint  space  comprising  of  both  0X  and  02. 

2.3  Redundancy  in  Space  Manipulator  Systems 

Space  robots  exhibit  nonholonomic  redundancy  [12]  -  a  special  type  of  redundancy 
that  exists  in  the  absence  of  ordinary  kinematic  redundancy.  Unlike  ordinary  kinematic 
redundancy,  nonholonomic  redundancy  manifests  itself  only  after  a  global  motion  and 
cannot  be  characterized  by  self-motion  manifolds,  lnspite  of  fundamental  differences,  both 
redundancies  are  responsible  for  nonrepeatable  motion  of  the  configuration  variables  under 
pseudoinverse  control.  The  nonrepeatability  in  the  configuration  variables  are  a  direct 
manifestation  of  nonholonomic  constraints  of  motion.  In  the  case  of  ordinarily  redundant 
terrestrial  robots  the  nonholonomic  constraints  are  imposed  by  the  pseudoinverse  control 


itself,  whereas  in  the  case  of  space  robots  the  nonholonomic  constraints  are  naturally 
imposed  by  the  conservation  of  angular  momentum. 

Consider  a  space  manipulator  system  with  manipulator  joint  variables  0i  e  Rm  in  a 
workspace  x  e  Rni.  The  manipulator  is  chosen  to  have  as  many  degrees  of  freedom  as  the 
dimension  of  the  workspace  to  exhibit  the  manifestation  of  nonholonomic  redundancy  in 
the  absence  of  ordinary  kinematic  redundancy.  The  orientation  of  the  space  vehicle  on 
which  the  space  manipulator  is  mounted  is  denoted  by  0O  e  Rk.  Figure  2  depicts  a  planar 
space  manipulator  for  which  m  =  2  and  k  =  1.  It  can  be  shown  [11],  [12]  that  the  direct 
kinematic  relation  of  the  space  manipulator  is  of  the  form 

x  =  f(Ol,00)  (17) 

which  has  the  structure 

x  =  7j  0i  + J0  0o  (18) 

in  differential  form.  The  nonholonomic  constraint  due  to  angular  momentum  conservation 
can  be  expressed  as  [11] 

eo  =  H(Oi)0l  (19) 

A  complete  description  of  the  matrix  H  e  Rkxm  can  be  found  in  [11].  Equation  (19)  can 
be  substituted  in  Eq.(18)  to  obtain 

x  =  J0u  J  =  {Jl  +  J0H)  (20) 

where  J  €  #"'xm  is  the  "generalized  Jacobian"  [19], 

The  generalized  coordinates  of  the  system  include  0i  e  R"'  and  0O  e  Rk.  The  total 
number  of  generalized  coordinates  is  (m  +  k)  and  the  dimension  of  the  workspace  is  m. 
The  redundancy  in  ihe  space  manipulator  system  is  due  to  the  higher  dimension  of  the 
generalized  coordinates  than  that  of  the  workspace.  The  difference  in  the  number  of 
generalized  coordinates  and  the  workspace  variables  is  equal  to  the  degree  of  redundancy 
in  the  system.  This  is  similar  to  ordinary  kinematic  redundancy  in  terrestrial  manipulators. 

A  fundamental  difference  in  the  redundancy  between  space  manipulators  and  terres- 
trial manipulators  is  that  the  dimension  of  the  input  space  is  equal  to  that  of  the  gener- 
alized coordinates  in  the  case  of  terrestrial  manipulators  whereas  for  space  manipulators, 
the  dimension  of  the  input  space  is  smaller  than  the  dimension  of  the  generalized  coor- 
dinates. The  inputs  for  terrestrial  manipulators  are  the  derivatives  of  all  the  generalized 
coordinates,  for  space  manipulators  they  comprise  of  the  derivatives  of  the  independent 
generalized  coordinates  only,  the  orientation  variables  of  the  space  vehicle  being  the  de- 
pendent generalized  coordinates. 

A  closer  look  at  Eqs.(19)  and  (20)  point  out  their  similarity  to  Eqs.(14)  and  (15). 
Though  the  equations  look  similar-,  they  are  fundamentally  different  because  Eqs.(14)  and 
(15)  are  holonomic  while  Eqs.(19)  and  (20)  are  nonholonomic  in  nature.    Due  to  this 


difference,  the  extended  Jacobian  method  of  redundancy  control  results  in  repeatable  joint 
motion  in  ordinarily  redundant  terrestrial  manipulators  whereas  the  pseudoinverse  control 
of  the  generalized  Jacobian  [19]  results  in  nonrepeatable  joint  motion  in  space  manipulators. 
A  more  complete  discussion  on  this  topic  is  presented  next. 

Consider  the  trajectory  control  in  the  three  different  cases  of:  (a)  a  nonholonomically 
redundant  space  manipulator,  (b)  an  ordinarily  redundant  terrestrial  manipulator,  and  (c) 
an  ordinarily  redundant  terrestrial  manipulator  using  the  extended  Jacobian.  For  case  (a) 
the  forward  kinematics  is  expressed  by  Eqs.(17)  and  (19).  Since  Eq.(19)  is  nonholonomic, 
a  closed  path  in  0\  space  does  not  imply  a  closed  path  in  the  0o  space.  This  implies  from 
Eq.(17)  that  a  closed  path  in  the  joint  space  of  the  space  manipulator  does  not  result  in 
a  closed  path  in  the  workspace.  For  cases  (b)  and  (c)  the  forward  kinematics  is  simply 
expressed  by  Eq.(l)  -  a  position  constraint.  Therefore  a  closed  path  in  the  joint  space 
will  necessarily  result  in  closed  trajectories  of  the  end-effector  variables.  For  end-effector 
trajectory  control  in  case  (a),  we  use  the  pseudoinverse  control  law  from  Eq.(20) 

01  =  J*  X  (21) 

to  plan  the  joint  trajectories.  Equation  (20)  is  a  nonholonomic  equation  because  it  was 
obtained  by  substituting  a  nonholonomic  equation,  namely  Eq.(19)  into  a  holonomic  equa- 
tion, namely  Eq.(18).  Therefore,  while  using  Eq.(21),  closed  trajectories  in  the  workspace 
will  generally  not  result  in  closed  trajectories  in  the  joint  space.  This  can  be  easily  proven 
by  contradiction.  Suppose  that  closed  trajectories  in  x  produce  closed  trajectories  in  Ox. 
We  know  from  the  nature  of  Eq.(19)  that  closed  trajectories  in  0X  do  not  usually  produce 
closed  trajectories  in  0O.  This  will  contradict  Eq.(17)  that  requires  the  trajectories  of  0U 
to  be  closed  for  closed  trajectories  of  x  and  0X.  For  case  (b)  closed  trajectories  in  the 
workspace  do  not  result  in  closed  trajectories  in  the  joint  space  whereas  for  case  (c)  they 
do.  This  follows  straight  from  our  discussion  in  section  2.2.  We  conclude  this  section  by 
summarizing  the  last  result  in  a  tabular  form. 

Closed  Path  in  Joint  Space  Closed  Path  in  Workspace 

implies  implies 

Closed  Path  in  Workpspace         Closed  Path  in  Joint  Space 

Space  Manipulator  False  False 

Redundant  Manipulator  True  False 

(Pseudoinverse  Control) 

Redundant  Manipulator  True  True 

(Extended  Jacobian) 

2.4  The  LBC  is  not  a  Sufficient  Condition  for  Repeatability 

Shamir  and  Yomdin  [16]  studied  the  repeatability  problem  in  redundant  manipulators 
and  derived  a  necessary  and  sufficient  condition,  the  Lie  Bracket  Condition  (LBC),  for 


repeatability.  In  this  section  we  will  show  that  the  LBC  of  [16]  is  not  a  sufficient  condition 
for  repeatability  when  applied  to  arbitrary  extended  Jacobians  [2].  This  contradicts  some 
of  the  discussion  made  in  [9]. 

In  simple  words,  the  LBC  [16]  states  that  repeatability  in  manipulators  is  assured  if 
and  only  if  the  Lie  Bracket  of  any  two  column  vectors  ki  and  k}  of  the  matrix  K,  K  being 
the  pseudoinverse  of  the  manipulator  Jacobian,  is  a  linear  combination  of  the  columns  of 
K. 

For  a  manipulator  with  as  many  degrees  of  freedom  as  the  dimension  of  the  workspace, 
the  control  matrix  K  is  simply  the  inverse  of  the  manipulator  Jacobian,  assuming  of  course, 
that  the  manipulator  is  not  at  any  singular  configuration.  The  LBC  is  satisfied  for  the 
square  and  full  rank  matrix  K,  and  indeed,  we  have  repeatable  joint  motion  when  the 
end-effector  moves  along  closed  paths. 

Since  the  LBC  is  always  satisfied  for  square  matrices  with  full  rank,  Luo  and  Ahmad 
[9]  extrapolated  that  repeatability  can  be  achieved  by  simply  converting  the  rectangular 
Jacobian  of  a  redundant  manipulator  into  a  square  matrix  by  imposing  additional  inde- 
pendent constraints.  They  supported  their  argument  with  the  example  of  the  extended 
Jacobian  [2].  This  method  achieves  repeatability  by  imposing  additional  independent  con- 
straints that  are  holonomic.  The  assertion  of  Luo  and  Ahmad  [9]  is  not  correct  because 
the  rectangular  Jacobian  may  be  extended  into  a  square  matrix  of  full  rank  by  imposing 
nonholonomic  constraints  as  well,  and  nonholonomic  systems  do  not  exhibit  repeatability. 
To  understand  better,  we  look  back  at  the  expressions  of  motion  of  a  redundant  manip- 
ulator under  extended  Jacobian  control  [2]  and  a  space  manipulator,  in  sections  2.2  and 
2.3  respectively.  Specifically,  we  compare  Eqs.(12)  and  (14)  in  section  2.2  with  Eqs.(18) 
and  (19)  in  section  2.3.  We  have  seen  in  section  2.3  that  these  two  systems  have  struc- 
turally identical  kinematical  equations  and  constraints  but  the  nature  of  their  constraints 
are  different.  Since  the  space  manipulator  has  nonholonomic  constraints,  closed  paths  in 
the  workspace  do  not  result  in  closed  paths  in  the  joint  space.  This  tells  us  that  if  the  con- 
straint in  Eq.(14)  were  nonholonomic,  the  pseudoinverse  control  of  the  extended  Jacobian 
of  the  redundant  manipulator  in  section  2.2  would  exhibit  nonrepeatable  joint  motion  as 
well. 

To  illustrate  nonrepeatability  in  redundant  manipulators  with  an  extended  Jacobian, 
we  consider  the  manipulator  in  Fig.l.  We  assume  all  the  link  lengths  to  be  equal  to  0.5  units 
for  the  sake  of  simplicity.  For  this  manipulator  which  has  a  single  degree  of  redundancy, 
we  impose  one  nonholonomic  constraint 

03  =  sin(fl!  +  03)  0i  +  eos(02  +  0S)  02 
The  extended  Jacobian  relation  of  the  manipulator  takes  the  following  form 

( X\  (     -sin0!  -sin  02         -sin03\     /0j\ 

I   Y      =  -  cos  0!  cos  02  cos  03  02  (22) 

\0J  Vsint^!  +  ^3)     cos(02  +  03)  -1      /     V03/ 

Except  at  the  singular  points,  the  pseudoinverse  of  the  extended  Jacobian  in  Eq.(22) 
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will  be  equivalent  to  the  inverse,  for  which  the  LBC  will  always  be  satisfied.  However, 
closed  paths  in  the  workspace  x  will  not  always  result  in  closed  paths  in  the  joint  space  0, 
as  seen  from  Fig.3.  Therefore,  the  assertion  made  in  [9]  is  not  correct. 

We  wish  to  make  two  comments  in  regard  to  Fig.3.  The  abcissae  and  ordinate  in  Fig.3 
are  in  different  scales.  Therefore  the  circular  path  of  the  end-effector  looks  elliptical.  For 
the  same  reason,  the  link  lengths  seem  to  vary  in  different  configurations.  Also,  it  may  be 
noted  that  the  manipulator  exhibits  a  limit  cycle  behavior  -  the  drift  in  the  joint  angles 
of  the  manipulator  decreases  as  the  end-effector  repeatedly  moves  along  the  closed  path. 
This  limit  cycle  behavior  of  redundant  manipulators  will  be  explained  later  in  section  5. 

3.  A  Necessary  Condition  for  Repeatability 

Shamir  and  Yomdin  [16]  studied  the  repeatability  problem  in  redundant  manipulators 
and  arrived  at  a  Lie  Bracket  Condition  (LBC)  as  a  necessary  and  sufficient  condition  for  re- 
peatability. The  LBC  is  by  itself  a  necessary  and  sufficient  condition  for  the  integrability  of 
the  distribution  associated  with  the  Jacobian  pseudoinverse.  This  comes  directly  from  the 
statement  of  l^robenius's  Theorem  [17].  This  was  proven  separately  for  the  3-dimensional 
case  in  [9],  [14].  In  essence,  Shamir  and  Yomdin  [16]  asserted  that  repeatability  can  be 
achieved  if  and  only  if  the  solution  to  the  pseudoinverse  control  problem  is  integrable.  We 
do  not  quite  agree  with  this  condition  since  there  exists  a  weaker  necessary  condition  for 
repeatability. 

Terrestrial  redundant  manipulators  under  pseudoinverse  control  and  nonholonomically 
redundant  space  manipulators  are  both  constrained  systems,  and  the  repeatability  problem 
in  these  redundant  systems  is  a  search  for  closed  trajectories  of  their  configuration  variables. 
We  take  into  consideration  the  constraints  of  the  systems  by  searching  for  closed  trajectories 
of  the  independent  configuration  variables  that  result  in  closed  trajectories  of  the  dependent 
configuration  variables.  The  change  in  the  dependent  configuration  variables  is  expressed 
as  a  line  integral  along  the  closed  path  in  the  space  of  the  independent  configuration 
variables.  This  line  integral  may  be  conviniently  expressed  as  a  surface  integral  using  the 
generalized  Stokes'  Theorem  on  a  manifold.  If  D  is  an  oriented  manifold  of  dimension  k, 
and  if  u  is  a  (k  -  l)-form  on  D,  then  from  Stokes'  Theorem  [1]  we  have 


JdD  J D 


du  (23) 


where,  dD  is  the  path  of  the  line  integration  and  is  the  boundary  of  the  domain  D,  and 
du  is  a  differential  fc-form  obtained  by  exterior  differ  en  tation  of  u>.  In  the  case  of  a  planar 
terrestrial  manipulator  with  three  links  and  a  single  degree  of  redundancy,  the  domain  D  is 
a  2-dimensional  manifold,  and  the  differential  1-form  on  D  has  the  functional  dependence 

u  -  </</)0  =  <Ji{<t>i,<t>2)d<j>i  +</2Oli0a)d02  (24) 

where,  (/>0  is  the  dependent  joint  variable,  and  <Pi  and  4>2  are  the  independent  joint  vari- 
ables of  the  manipulator.  If  Eq.(24)  were  to  depict  the  constraint  in  a  nonholonomically 
redundant  planar  space  robot  with  two  links,  <&>  would  represent  the  orientation  of  the 
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space  vehicle  in  the  plane,  and  fa  and  fa  would  represent  the  joint  variables  of  the  two 
link  manipulator. 

Using  Stokes'  theorem,  the  line  integration  of  dfo  along  a  path  3D  on  the  2-dimensional 
manifold  D  of  4>x  and  4>2  is  expressed  as 


dcfri  A  d(j>2 


(     d4>0=  f 
JdD  J  D° 


9(J2 

dgi~ 

dfa  ' 

d(j>2 

[dfa 

04>2_ 

where  "a"  denotes  the  exterior  product,  and  a,  the  orientation  of  D  has  the  same  orien- 
tation as  d4>x  a  d4>2  when  the  direction  along  the  path  is  counterclockwise,  otherwise  a  has 
the  same  orientation  as  dfa  a  dfa . 

If  the  constraint  given  by  Eq.(24)  were  a  holonomic  constraint,  then  we  would  have 

^1  =  ^1  (25) 

#</>!  d(p2 

Then  the  change  in  the  variable  <p0  would  be  zero  for  all  closed  paths  in  the  domain 
D  because  of  the  integrable  nature  of  the  constraints.  This  would  ensure  repeatability. 
Our  contention  is  that  integrability  is  a  sufficient  condition  for  repeatability  but  is  not 
a  necessary  condition.  For  the  nonholonomically  redundant  space  manipulator  or  the 
terrestrial  redundant  manipulator  the  condition  given  by  Eq.(25)  does  not  hold  good,  yet 
repeatability  can  be  achieved  for  certain  closed  paths  in  the  domain  D.  We  define 

d<f>i      04>2 
The  change  in  the  dependent  joint  variable  <f>o  of  the  redundant  manipulator  for  a  positive 
direction  of  travel  in  the  space  of  the  independent  joint  variables  is  equivalent  to 


/      dfa  =    /    F(4>i,<P2)  d<pid(/)2 
JdD  Jd 

-  FMA2)  I  ^id^2  =  F(4>\,ti)A(D) 
Jd 


where,  the  above  equation  was  obtained  by  the  application  of  the  mean  value  theorem 
of  integral  calculus.  The  function  F  is  assumed  to  be  continuous  in  the  entire  domain 
D  and  hence  the  mean  value  theorem  applies.  (f>\  and  4>\  denote  some  point  within  the 
domain  D,  and  A{D)  is  the  measure  of  the  domain  D;  in  this  case  it  is  simply  equal  to  the 
area  enclosed  within  the  closed  curve  3D.  F{4>\,(f>2)  can  also  be  interpreted  as  the  mean 
value  of  the  function  F,  defined  in  Eq.(2G),  taken  over  the  domain  D.  If  this  mean  value 
happens  to  be  zero,  then  we  would  have  a  zero  net  change  in  the  dependent  joint  variable 
of  the  redundant  manipulator.  This  would  ensure  repeatability  in  the  joint  motion  of  the 
terrestrial  manipulator.  For  the  space  manipulator  this  would  ensure  repeatability  in  the 
motion  of  the  end-effector  in  the  workspace.  We  are  now  ready  to  state  the  necessary 
condition  for  the  repeatable  motion  of  the  redundant  manipulator. 
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Proposition:  A  necessary  condition  for  the  repeatable  motion  of  the  redundant  manipu- 
lator is  that  the  closed  path  t)D  which  is  the  boundary  of  the  domain  D  in  the  independent 
configuration  space  should  enclose  at  least  one  point  where  the  function  F  defined  by 
Eq.(26)  is  equal  to  zero. 

The  proof  of  the  proposition  stated  above  is  quite  straightforward  and  is  left  to  the  reader. 

If  the  necessary  condition  for  repeatability  is  satisfied,  it  may  be  possible  to  find 
paths  in  the  space  of  the  independent  configuration  variables  such  that  the  net  change 
of  the  dependent  configuration  variables  is  zero  over  the  closed  path.  The  closed  path  in 
the  independent  configuration  space  will  then  be  like  a  "holonomic  loop"  over  which  the 
nonholonomic  system  will  exhibit  holonomic  behavior  globally.  Incidentally,  the  holonomic 
loops  will  not  belong  to  any  integral  surface  and  as  such  the  LBC  or  the  integrability 
condition,  defined  in  Appendix-A,  will  not  be  satisfied  at  all  points  along  the  loop. 

4.  Repeatability  in  Nonholonomically  Redundant  Space  Manipulators 

There  are  two  different  repeatability  problems  for  a  space  manipulator  system:  (a)  the 
direct  problem  of  finding  a  closed  path  in  the  joint  space  of  the  manipulator  such  that 
the  end-effector  traces  a  closed  path,  and  (b)  the  inverse  problem  of  finding  a  closed  path 
in  the  workspace  that  will  result  in  a  closed  path  in  the  joint  space  under  pseudoinverse 
control.  The  inverse  problem  can  be  solved  by  simply  solving  the  direct  problem  when 
the  number  of  manipulator  joints  is  equal  to  the  dimension  of  the  workspace,  as  in  our 
case.  This  is  true  because  in  such  situations  the  pseudoinverse  is  identical  to  the  inverse 
assuming  that  the  manipulator  is  not  at  any  singular  configuration.  In  this  section  we 
consider  the  direct  repeatability  problem  of  a  planar  space  robot  with  two  links  mounted 
on  a  space  vehicle  as  shown  in  Fig. 2.  Since  the  manipulator  has  two  links,  the  system  will 
exhibit  nonholonomic  redundancy  in  the  absence  of  ordinary  kinematic  redundancy. 

The  Cartesian  coordinates  of  the  end-efiector  xe,  ve  of  the  manipulator  have  a  func- 
tional dependence  of  the  form 

XE  =  h  (^0,3/0,^0,^1,^2),  VE  —  h  (20,2/0,00,  01,02)  (27) 

where  x0  and  y0  are  the  coordinates  of  the  center  of  mass  of  the  space  vehicle,  0O  is  the 
orientation  of  the  vehicle,  and  0X  and  0-2  are  the  joint  variables.  The  motion  of  the  center  of 
mass  of  the  space  vehicle  is  governed  by  a  holonomic  constraint  due  to  linear  momentum 
conservation.  For  zero  initial  linear  momentum,  this  can  be  reduced  to  the  form  [11] 

ZO  =  /3(0O,01,02),  2/0  =  /4  (00,01,02)  (28) 

Since  we  are  looking  into  the  repeatability  problem  of  a  planar  space  robot,  we  consider 
closed  trajectories  of  the  joint  variables.  If  the  orientation  of  the  space  vehicle  trace  a  closed 
curve  as  the  joints  move  along  a  closed  trajectory,  it  is  clear  from  Eqs.(27)  and  (28)  that  all 
the  configuration  variables  including  xq,  2/0,  xe,  and  yE  will  move  along  closed  trajectories. 
This  is  not  true  in  the  general  case. 
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When  the  joints  move  along  closed  trajectories  and  the  system  maintains  zero  angular 
momentum,  the  change  in  the  orientation  of  the  space  vehicle  is  expressed  as  a  surface 
integral  using  the  generalized  Stokes'  Theorem  on  a  manifold,  as  given  by  Eq.(23).  The 
domain  D  will  be  the  2-dimensional  joint  space  of  the  manipulator  and  the  differential 
1-form  on  D  will  be  the  constraint  due  to  the  conservation  of  angular  momentum,  given  as 

u  =  d0o  =  gi(0ltB2)  dQx  +  g2(9u  02)  d02 


^  d01  -  (£\  d02  (29) 


A 


where  At  B,  and  C  are  functions  of  6i  and  02  and  are  defined  in  Appendix-B.  The  function 
F  defined  in  Eq.(26)  is  therefore  equal  to 

^■«*A(!)-AS) 

We  now  present  a  simple  method  to  plan  repeatable  paths  for  the  space  manipulator. 
All  paths  that  will  ensure  repeatability  will  have  to  satisy  the  necessary  condition  for 
repeatability,  developed  in  section  3.  Therefore,  we  first  take  a  look  at  all  points  in  the 
0i-02  space  where  the  function  F{0lt02)  in  Eq.(30)  is  identically  zero.  The  set  of  all  such 
points  constitute  a  smooth  curve,  as  seen  in  Fig.4. 

We  assume  our  closed  path  to  have  an  elliptical  shape.  This  path,  as  seen  in  Fig. 5, 
can  be  parameterized  as  follows: 

01  =  0io  +  a  cos  0  cos  '2nt  —  b  sin  (j>  sin  2nt 

te|o,i)  (31) 

62  =  02q  +  a  sin  <p  cos  2-nt  -\  b  cos  <$>  sin  2nt 

where,  a,  and  6  are  the  major  and  minor  axes  of  the  ellipse,  4>  is  the  angle  of  inclination 
of  the  ellipse  with  the  0i  axis,  and  010  and  020  are  the  coordinates  of  the  center  of  the 
ellipse.  The  velocities  of  the  joints  of  the  manipulator  can  be  easily  obtained  from  the 
above  equation  as  a  function  of  time.  Consequently,  the  rate  of  change  of  the  orientation 
of  the  space  vehicle  can  be  obtained  from  Eq.(29)  as  a  function  of  time. 

We  start  with  an  initial  elliptical  path  which  is  characterized  by  the  parameters  0io, 
02o,  «,  b,  and  <f>.  The  initial  choices  of  these  parameters  are  quite  arbitrary.  We  only  make 
sure  that  the  elliptical  path  encompasses  at  least  one  point  where  the  function  F  defined 
by  Eq.(30)  is  equal  to  zero.  This  condition  can  be  easily  satisfied  by  considering  FigA 
which  provides  the  set  of  all  points  where  the  function  F  vanishes. 

Our  goal  is  now  to  change  the  five  parameters  of  the  ellipse  so  that  the  surface  integral 
of  the  function  F  in  Eq.(30)  over  the  elliptical  path  is  equal  to  zero.  Of  the  five  different 
parameters  a  and  b  are  not  allowed  to  change  independent  of  one  another.  This  is  because 
we  want  to  eliminate  the  trivial  solution  where  the  surface  integral  is  zero  because  the  area 
of  the  closed  path  is  equal  to  zero.  One  simple  way  to  avoid  this  situation  is  to  impose  the 
restriction  that  the  urea  of  the  ellipse  is  a  constant.  This  is  equivalent  to  the  constraint 

a<U>  +  bda  =  0  (32) 
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We  define  a  function  V  as  follows 

V  =  C2,  C  =  JJ  F(0u02)d0ld02  (33) 

and  solve  the  unconstrained  minimization  problem  by  implicitly  assuming  that  a  and  b 
are  dependent.  In  Eq.(33)  C  is  equal  to  the  net  change  in  the  orientation  of  the  space 
vehicle  as  the  joint  variables  move  along  closed  paths.  While  there  are  many  methods  for 
unconstrained  minimization,  we  choose  the  simplest  method  of  steepest  descent  [20].  Other 
alternative  methods  that  can  be  used  are  the  conjugate  direction  method  by  Fletcher  and 
Reeves  [4],  and  the  variable  metric  method  [20]  that  offer  improvement  over  the  method 
of  steepest  descent.  In  our  case  the  method  of  steepest  descent  works  well  and  therefore 
we  adopted  it  only  for  its  simplicity. 

The  correct  choice  of  the  independent  parameters  9l0,  d2o,  4>,  and  a  that  provied  us 
with  the  steepest  direction  of  descent  of  the  function  V  are  computed  as 

00  io  00-20  "<P  oa 

In  the  above  equation,  the  quantities  {OQ/O0m),  (OC,/002i)),  {0Q/0<l>),  and  {0Q/0a)  are  com- 
puted by  numerical  partial  differentiation.  While  computing  the  term  (0C/0a)  it  has  to  be 
remembered  that  a  change  in  o  is  accompanied  by  a  change  in  b  given  by  the  constraint  in 
Eq.(32). 

The  optimization  technique  discussed  above  provides  us  with  a  systematic  way  to 
reach  the  local  minimum  value  of  the  function  V .  If  this  minimum  value  is  zero,  then  we 
have  converged  upon  the  desired  path  around  which  the  space  robot  will  exhibit  pseudo- 
holonomic  behavior.  In  the  general  case,  the  method  of  steepest  descent  does  not  guarantee 
the  convergence  of  a  function  to  its  global  minimum  value.  However,  in  our  case  the  method 
always  converged  to  the  global  minimum  value  of  V  -  0,  because  of  the  particular  nature 
of  the  function  F  in  Eq.(30). 

5.  Repeatable  Motion  under  Pseudoinverse  Control 

The  repeatability  problem  in  redundant  manipulators  under  pseudoinverse  control  is 
a  search  for  closed  trajectories  of  the  end-effector  that  result  in  closed  joint  trajectories. 
Since  the  pseudoinverse  control  is  actually  a  form  of  nonholonomically  constrained  motion, 
closed  joint  trajectories  can  be  obtained  only  if  the  dependent  joint  variables  move  along 
a  closed  path  as  the  independent  joint  variables  do.  Our  logical  first  step  is  therefore 
to  search  for  closed  trajectories  of  the  independent  joint  variables  that  result  in  closed 
trajectories  of  the  dependent  joint  variables. 

To  further  our  discussion,  we  consider  the  planar  redundant  manipulator  in  Fig.l  with 
unity  link  lengths.  This  example  was  considered  in  [7],  [9],  and  [16].  The  kinematic 
relations  of  this  manipulator  are  given  in  Eq.(4)  and  its  Jacobian  is  given  by  Eq.(5).  The 
nonholonomic  constraint  of  the  manipulator  under  pseudoinverse  control  is  given  by  Eq.((i), 
which  is  not  of  the  form  given  by  Eq.(24).  To  reduce  it  to  this  form,  we  use  the  simple 
transformation 
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1>i  =  olt   ■4>2  =  e2-ou    i>3  =  o3-Q2  (34) 

The  transformed  constraint  equation 

(sin(02  +  03)  -  sin  02  -  sin  03]  #1  -  sin  02  <^03  +  [sin(V'2  +  0s)  -  sin  02]  ^02  =  n  (35) 

is  then  of  the  form  as  given  by  Eq.(24).  Under  the  assumption  that 

sin  V>2  +  sin  03  -  8411(02  +  03)  7^  °  (36) 

the  change  in  the  dependent  variable  0i,  as  the  independent  variables  V2  and  V'a  move 
along  a  closed  path,  can  be  shown  to  be 

/       c/0i  =    //     j-. ; — ; — .,    dfodlps 

J dD  JJd  ls»n  02  +  sin  03  -  sin(02  +  03)] 

using  Stokes'  Theorem  [1].  The  function  F  defined  by  Eq.(26)  is  given  as 

W2,  03)  =    ..       J——.       .    1        r-TT-r-TTi  ^ 

[sin  02  +  sin  03  -  sin(02  +  03)] 

and  is  not  equal  to  zero  anywhere  in  the  02-03  plane.  The  necessary  condition  for  repeata- 
bility is  therefore  not  satisfied.  This  means  that  when  the  condition  in  Eq.(36)  holds  good, 
the  redundant  manipulator  cannot  exhibit  repeatability.  The  condition  in  Eq.(36)  does 
not  hold  good  when  we  have  any  one  of  the  three  cases 

(a)  02-0  <=*  0i  =  02 

(b)  ^3  =  0  ^=>  02  =  03 

(C)      02  +  03-0  <=>  #3  =  Oi 

Using  Eq.(35),  it  is  possible  to  show  that  the  three  cases  above  imply 

(a)    02  =  0  t-*  dip2  =  0 

(6)    ^3-0  ~  dfo  =  0 

(C)      02  +  ^3  =  0  ►-»  </(02    1-03)  -0 

Therefore,  each  of  the  three  cases  represent  an  integral  surface.  These  results  are  identical 
to  that  obtained  by  Shamir  and  Yomdin  [16]  using  the  Lie  Bracket  Condition  (LBC).  We 
have  to  agree  that  for  the  particular  example  considered,  repeatability  can  be  achieved 
only  if  the  LBC  holds  good,  i.e.  the  LBC  is  a  necessary  condition  for  repeatability. 

The  LBC  is  not  a  necessary  condition  for  repeatability  in  the  general  case.  To  illustrate 
this  concept  we  consider  the  same  manipulator  as  in  Fig.  1,  but  we  redefine  the  configuration 
variables.  Once  again  we  assume  the  link  lengths  to  be  unity  for  the  sake  of  simplicity. 
If  the  new  configuration  variables  are  0i,  02,  and  03,  as  defined  by  Eq.(34),  then  the 
kinematic  relations  of  the  manipulator  are 
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X  =  COS  V'l  +  COS  V»12  +  COS  V»123 

(38) 
Y  —  sin  V»i  +  sin  ^12  +  sin  V>m 

and  the  manipulator  Jacobian  is  given  by 

J    =  (  _sin^i  _sin ^12  —  sin ^123      -sin ^12 -sin ^m      -sin ^123  \  ,—» 

\^      COSV'I  +COsV'l2  +  COS^123  COS  ^12  +  «>S  V>123  COS  V»123  / 

where  we  used  the  compact  notation  V12  and  V123  to  denote  (^1  +  ^2)  and  (V'i  +  4>i  + 
V>3)  respectively.  We  note  that  the  Jacobian  J^  in  the  above  equation  is  quite  different 
from  the  Jacobian  J0  in  Eq.(5).  Consequently,  the  pseudoinverse  control  for  J^  would  be 
considerably  different  from  that  of  J0. 

The  nonholonomic  constraint  of  the  manipulator  under  pseudoinverse  control  of  J0  is 
found  to  be 

sin  03  dxjjy  -  [sin  03  +  sin(^2  +  V'3)]  dfa  +  [sin  ^2  +  sin(^2  +  ^3)]  ^03  =  0  (40) 

Assuming  sin  1^3  ^  0,  the  change  in  the  dependent  variable  -0i,  as  the  independent  variables 
%l>2  and  ^3  move  along  closed  paths,  can  be  shown  to  be 

f     a  1  ff  sin  03  cos  ^2  +  sinV'3Cos(V'2  +  03)  -  sin  ^2     ,  ,     ,,  ,.,, 

/      "V'l  =   //    : — -n <i02"03  (41) 

J  an  JJd  sin  -03 

The  function  /''  defined  in  Eq.(2G)  is  therefore  equal  to 

„,  .  A  sin  03  cos  02  +  sin  V3  cos(^2  +  ^3)  -  sin  V>2  ,  .ox 

F{i>2,fo)= ; — —2 (42) 

sin  03 

To  plan  repeatable  paths  for  the  redundant  manipulator  under  pseudoinverse  control, 
the  necessary  condition  for  repeatability  discussed  in  section  3  has  to  be  satisfied.  There- 
fore, we  take  a  look  at  a  set  of  points  where  the  function  F(ip2,  4>s)  vanishes.  A  set  of  these 
points  is  given  in  Fig. 6.  We  assume  the  closed  path  in  the  space  of  the  independent  joint 
variables,  V2  and  ^3,  to  have  an  elliptical  shape,  as  shown  in  Fig. 7.  The  path  in  V2  and 
V»3  is  parameterized  in  a  way  similar  to  Eq.(31).  We  start  with  an  initial  choice  of  the 
parameters  V>2o,  ^30,  «,  b,  and  <f>.  The  choice  is  quite  arbitrary  except  for  the  fact  that  the 
path  should  enclose  at  least  one  point  where  the  function  F  defined  by  Eq.(42)  is  equal 
to  zero.  This  condition  can  be  satisfied  by  considering  Fig.G.  Our  goal  is  now  to  change 
the  five  parameters  of  the  elliptical  path  so  that  the  surface  integral  of  the  function  F  in 
Eq.(42)  over  the  path  is  equal  to  zero.  We  achieve  our  goal  by  adopting  the  optimization 
technique  outlined  in  section  4.  The  optimized  path  can  then  be  likened  to  a  "holonomic 
loop"  over  which  the  joint  angles  of  the  redundant  manipulator  will  exhibit  holonomic 
behavior  globally. 

Let  us  define  the  optimized  closed  path  in  the  joint  space  to  be  Cj.  Using  forward 
kinematics,  as  given  by  Eq.(38),  we  can  obtain  a  closed  path  in  the  workspace  C\v  of  the 
redundant  manipulator  from  Cj.    Under  pseudoinverse  control,  Cw  will  map  back  to  Cj 
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in  the  joint  space.  This  is  true  because  (a)  the  mapping  Cj  ■ — ►  Cw  satisfies  the  kine- 
matic relations  of  the  manipulator,  and  (b)  the  closed  path  Cj  satisfies  the  nonholonomic 
constraint  due  to  pseudoinverse  control. 

Before  we  conclude  this  section  we  wish  to  make  two  comment: 

1.  It  can  be  shown  that  the  Lie  Bracket  Condition  (LBC)  in  [16]  is  not  satisfied  at  every 
point  on  Cj,  yet  the  net  change  in  the  dependent  joint  variable  Vi  along  Cj  is  zero. 
Therefore,  we  can  achieve  repeatability  in  the  absence  of  an  integral  surface. 

2.  Our  second  comment  is  in  regards  to  the  limit  cycle  behavior  in  redundant  manipu- 
lators. It  was  noted  in  [7]  that  under  pseudoinverse  control  some  manipulators  drift 
continuously  while  others  exhibit  limit  cycle  behavior.  Our  studies  lead  us  to  believe 
that  the  drift  in  a  redundant  manipulator  may  be  self-optimizing  in  the  sense  that 
the  drift  may  decrease  with  every  cycle  of  end-effector  motion.  When  such  a  situation 
arises,  the  drift  finally  goes  to  zero  and  the  manipulator  reaches  a  limit  cycle. 

6.  Simulations 

6.1  A  Nonholonomically  Redundant  Space  Manipulator 

We  carried  out  several  computer  simulations.  Here  we  present  results  of  one  particular 
case.  The  kinematic  and  dynamic  parameters  of  the  planar-  space  robot  were  chosen  to  be 

Kinematic  and  Dynamic  parameters 


Mass 

Inertia 

Length 

(kg) 

(kg-7n2) 

(m) 

Vehicle 

27.440 

1.520 

r  =  0.20 

Link-1 

5.380 

0.115 

/,  =  0.50 

Link-2 

2.G40 

0.028 

/,  =  0.35 

The  initial  parameters  of  the  elliptical  path  were  arbitrarily  chosen  as 

a  =1.50000,    6=1.00000,    0  =  0.75000,    01O  =  0.50000,    02O  =  0.50000  (43) 

where  the  units  are  in  radians.  For  these  set  of  values,  the  numerical  value  of  the  surface 
integral  C  was  found  to  be  C  =  -0.1G2775.  The  convergence  criterion  was  set  at  |  CI  < 
1.0  x  10~8.  The  values  of  the  path  parameters  after  convergence  were 

a  =1.31117,    6=1.14381,    0  =  0.79302,    0IO  =  0.34094,    02o  =  -0.07054  (44) 

The  two  elliptical  paths  are  shown  in  Fig.8.  Ellipse  /  corresponds  to  the  initial  choice 
of  the  path  parameters  given  by  Eq.(43)  for  which  the  value  of  C  =  -0.162775.  Ellipse 
II  corresponds  to  the  optimized  values  of  the  path  parameters  given  by  Eq.(44)  and  the 
value  of  C  for  this  path  was  C  =  -9.9G3G  x  10~9.  The  sinusoidal  curve  in  Fig. 4  is  inset,  in 
Fig.8.  This  curve  passes  through  both  paths  I  and  II  and  therefore  these  paths  satisfy  the 
necessary  condition  discussed  in  section  3. 
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Figures  9  and  10  depict  the  motion  of  the  end-effector  of  the  space  robot  for  20  cycles 
for  the  elliptical  paths  I  and  77  respectively.  The  end-effector  configuration  is  seen  to  drift 
in  Fig.9  but  has  negligible  drift  for  the  closed  path  in  Fig.  10.  The  magnitude  of  the  drift 
was  computed  to  be  approximately  76. 9G  mm/cycle  in  the  case  of  path  I  whereas  it  was 
only  0.87  mm/cycle  for  path  II. 

6.2  An  Ordinarily  Redundant  Terrestrial  Manipulator 

We  considered  the  simple  case  of  a  planar  three  link  manipulator  with  one  degree 
of  redundancy,  as  shown  in  Fig.l.  The  kinematic  relations  of  the  manipulator  and  its 
Jacobian  are  given  by  Eqs.(38)  and  (39).  We  assumed  the  links  of  the  manipulator  to  have 
equal  lengths  of  0.5  metres. 

The  initial  parameters  of  the  elliptical  path  was  arbitrarily  chosen  as 

a  =1.00000,    6=1.00000,    0  =  0.00000,    V20  =  0.75000,    ^30  =  150000  (45) 

where  the  units  are  in  radians.  For  these  set  of  values,  the  numerical  value  of  the  surface 
integral  C  was  found  to  be  C  =  19838025.  The  convergence  criterion  was  set  at  |  C  I  < 
1.0  x  10~8.  The  values  of  the  path  parameters  after  convergence  were 

a  =1.03337,    6  =  0.90769,    ^  =  0.00232,     V20  =  0.51512,    V30  =  142478  (40) 

The  two  elliptical  paths  are  shown  in  Fig.l  1.  Ellipse  I  corresponds  to  the  initial  choice 
of  the  path  parameters  given  by  Eq.(45)  for  which  the  value  of  Q  =  1.9838025.  Ellipse  II 
corresponds  to  the  optimized  values  of  the  path  parameters  given  by  Eq.(46)  and  the  value 
of  C  for  this  path  was  C  =  9  9131  x  I0~a.  The  sinusoidal  curve  in  Fig. 6  is  inset  in  Fig.  11.  This 
curve  passes  through  both  paths  /  and  77  and  therefore  these  paths  satisfy  the  necessary 
condition  discussed  in  section  3. 

Path  II  in  Fig.  11  is  the  optimized  path  in  the  ^2-03  plane  of  the  manipulator  that 
results  in  closed  loop  motion  of  the  dependent  joint  variable  Vi-  For  an  initial  value  of 
4>i  -  0.0,  the  closed  end-effector  trajectory  Cw  that  is  obtained  from  these  closed  joint 
trajectories  Cj  is  shown  in  Fig.  12.  Figure  12  also  shows  the  link  configuration  of  the 
manipulator  at  six  different  points  along  the  trajectory.  The  joint  trajectories  obtained 
through  pseudoinverse  control  of  the  closed  end-effector  trajectory  in  Fig.  12  are  shown  in 
Fig.  13.  The  joint  trajectories  in  Fig.  13  pertain  to  5  cycles  of  end-effector  motion.  The 
numerical  simulation  was  continued  for  more  than  100  cycles  and  the  joints  were  seen  to 
have  exceptional  repeatability.  This  conforms  to  our  discussion  in  section  5. 

We  wish  to  make  two  comments  at  this  juncture: 

1.  The  Lie  Bracket  Condition  (LDC)  in  [1G]  is  essentially  a  test  for  integrability  of  the 
distribution  spanned  by  the  column  vectors  of  the  Jacobian  pseudoinverse.  Though 
the  LBC  can  be  verified  from  the  Jacobian  transpose  instead  of  the  pseudoinverse  [9], 
[14],  it  may  still  involve  a  significant  amount  of  symbolic  computation.  An  easier  way 
out  is  to  test  the  integrability  of  the  constraint  imposed  by  the  pseudoinverse  control. 
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We  can  use  Eqs.(7)  and  (8)  to  test  the  integrability  of  the  pseudoin verse  constraint 
In  Eq.(40).  For  the  joint  trajectories  in  Fig. 13  it  can  be  shown  that  the  condition  for 
integrability  is  not  satisfied  at  all  points  along  the  path,  i.e.  Fifatfo)  m  Eq.(42)  is  not 
zero  at  all  points  along  the  path.  Therefore  repeatability  is  achieved  in  the  absence  of 
integrability.  This  refutes  the  LBC  in  [16]. 

2.  Since  the  end-effector  trajectory  is  generated  from  the  joint  trajectories  and  since 
the  initial  configuration  of  the  dependent  joint  variable,  Vi  in  our  case,  is  completely 
arbitrary,  any  rotation  of  the  end-effector  trajectory  in  Fig.  12  about  the  z-axis  will  also 
produce  repeatable  joint  motion.  Clearly,  there  are  infinite  end-effector  trajectories 
that  produce  repeatable  joint  motion. 

7.  Conclusion 

In  this  paper  we  promoted  the  concept  that  integrability  is  not  a  necessary  condition 
for  repeatability  in  nonholonomic  systems.  This  allows  us  to  plan  repeatable  trajectories 
for  free-flying  space  manipulators  with  zero  initial  momentum  whose  constraint  due  to  the 
conservation  of  angular  momentum  is  not  integrable.  This  is  important  because  it  allows 
a  space  manipulator  to  perform  repeated  tasks  in  space  without  any  drift  in  its  configura- 
tion variables.  For  terrestrial  manipulators  under  pseudoinverse  control  the  nonholonomic 
constraint  is  imposed  by  the  control  law.  We  showed  that  under  pseudoinverse  control, 
repeatability  of  the  joint  variables  can  be  achieved  in  the  absence  of  any  integral  surface 
and  by  virtue  of  the  presence  of  "holonomic  loops".  These  loops,  when  they  exist,  allow 
a  nonholonomic  system  to  exhibit  repeatability  in  its  configuration  variables.  In  this  pa- 
per we  presented  a  simple  optimization  technique  for  planning  repeatable  trajectories  for 
both  nonholonomically  redundant  space  manipulators  and  ordinarily  redundant  terrestrial 
manipulators. 
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APPENDIX-A 

The  necessary  and  sufficient  condition  that  the  differential  constraint  in  n  variables 

vi  dx\  +  i>2  dx2  +  •  — f-  vn  dxn  =  0 
is  integrable,  is  that  the  set  of  equations 

\dxx       OxhJ        M   \0x„       d-£\)  \dxfi       dxv) 

(A,/i,i/=  1,2,  ■   -,n) 

are  satisfied  simultaneously  for  all  different  combinations  of  A,  /x  and  v  [5]. 

APPENDIX-B 

The  terms  A,  B,  and  C  in  Eq.(29)  are  defined  as  follows 


a  1  I2  I2 

A  —  It  +  -r7»*2«io(mi  +  m2)  +  -tt("1o«ii  +  m!??i2  +  4?7z0m2)  +  -tt"12(»io  +  mi) 
M  AM  AM 

-\  -j-7ino(ini   I"  2m2)rl{cos0i  -|  — 1112(1110  -\-^-^ini)hhcosO-i  I   —  mom'/r^co^i   I  ^2] 


a  /2  /2  2 

B  =  Ii  +  I2  +  t7t(7'1o"«i  +  m1m2  +  m0m2)  +  TT7m2(mo  +  «*i)  +  T7mo(mi  +  2m2)rlicos0\ 
AM  4il/  Ai 

+  -T7m'Amo  +0.5ml)lll2cos02  +  -^-rzrii0m2rl2cos(0i  +  02) 

A  l'2  1  1 

C  ==  ^2  +  TT7m2("lO  +  mi)  +  —rjinoi^li  I2COS62  +  7-T7morri2rl2COs(Oi  +  02) 
AM  2M  2M 

where,  mo,  mi,  and  m2  are  the  masses  of  the  space  vehicle  and  the  two  links  of  the  ma- 
nipulator, I0,  Ii,  and  I2  are  the  moment  of  inertias  of  the  space  vehicle  and  the  two  links 
about  their  center  of  masses,  r  is  the  distance  of  the  first  joint  from  the  center  of  mass  of 
the  vehicle,  /1  and  h  are  the  lengths  of  the  two  links,  M  =  m0  +  mi  +  m2,  and  It  =  IQ-\  h  +  L2. 
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Figure  1.  A  planar  three  link  redundant  manipulator. 
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Figure  2.  A  two  link  planar  space  manipulator  mounted  on  a  space  vehicle. 
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Figure  3.     Nonrepeatable  joint  motion  of  the  three  link  redundant  manipulator  under 
pseudoinverse  control  of  its  extended  Jacobian. 
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Figure  4.  The  locus  of  points  in  the  Oi-O*  plane  of  the  planar  space  robot  where  F{0U02)  -  0. 
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e. 


a  =  semi-major  axis  of  ellipse 
b  =  semi-minor  axis  of  ellipse 


(Tl1,1l2)  =  (acost,bsint) 


-^e, 


Figure  5.  Parametric  representation  of  the  elliptical  path  in  the  joint  spa.ce  of  the  space 
robot.  P  is  the  center  of  the  ellipse,  and  4>  is  the  angle  between  the  major  axis  of  the  ellipse 
and  0i. 
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Figure  6.    The  locus  of  points  in  a  certain  region  of  the  V2-V»3  plane  of  the  three  link 
redundant  manipulator  where  FOfa.^a)  =  0. 
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Figure  7.  Parametric  representation  of  the  elliptical  path  in  the  space  of  the  independent 
joint  variables  of  the  redundant  manipulator.  P  is  the  center  of  the  ellipse  whose  major 
axis  subtends  an  angle  </»  with  ^2- 
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Figure  8.  Elliptical  paths  in  the  joint  space  of  the  planar  space  robot.  Path  I  is  the  initially 
chosen  path  and  Path  11  is  the  optimized  path. 
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Figure  9.  End-effector  drift  in  20  cycles  for  Path  1  in  the  joint  space  of  the  space  robot. 
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Figure  10.  Repeatable  end-effector  motion  for  Path  II  in  the  joint  apace  of  the  apace  robot. 


31 


Cti 
Sh 


2 


1 


0  - 


1 


0 


"l 1 r 


i  i  r 


"i r 


Path  I 


J 1 I L 


J I I L 


2 


J L_ 1 L 


3 


f3  (rad) 


Figure  11.  Elliptical  paths  in  the  space  of  the  independent  joint  variables  of  the  three  link 
redundant  robot.  Path  I  is  the  initially  chosen  path  and  Path  II  is  the  optimized  path. 
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Figure  12.  The  closed  path  in  the  figure  depicts  an  end-effector  trajectory  that  will  produce 
repeatable  joint  motion  under  pseudoinverse  control.  The  figure  also  shows  the  configura- 
tion of  the  redundant  manipulator  at  six  different  points  along  the  trajectory. 
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Figure  13.  The  repeatable  joint  trajectories  of  the  three  link  redundant  manipulator  gen- 
erated through  pseudoinverse  control  of  the  end-effector  trajectory  in  Figure  12. 
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